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Abstract 



The invention proposes a self-contained mobile unit having a folding manipulator arm, the end of which 
takes the form of an effector, e.g. a suction nozzle or a brush. Here, the arm is fitted to rotate on the self- 
contained mobile unit and can cover a surface. It consists of several segments, the ends of which are 
connected together to rotate. The angles of rotation can be mutually independently adjusted. This provides 
great flexibility in the arm movement. The control process provides an advantageous algorithm by means of 
which the unit and the manipulator arm can be controlled. Preference may be given to a hybrid embodiment 
in which the effector can be pressed against a wall at a pressure which can be measured by a force sensor 
so that the unit follows the effector. Fields of application are, for instance, industrial vacuum cleaners, self- 
contained robots for painting walls, or mail delivery vehicles. 
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) Mit der Erfindung wird eine autonome mobile Einheit 
vorgestellt, die einen z usamme nfaltbaren Manipulatorarm 
besitzt, dessen Ende als Effektor, beispielsweise eine Saug- 
duse oder ein Ptnsei ausgebildet ist. Der Arm ist dabei 
drehbar an der autonomen mobilen Einheit befestigt und 
kann eine Flache uberstreichen. Er besteht aus mehreren 
Segmenten, die an ihren Enden drehbar miteinander verbun- 
den sind. Die jeweiligen Drehwinkel konnen unabhangig 
voneinander eingestellt werden. So ist es moglich, eine hone 
Flexibility bei der Bewegung des Armes zu erreichen. Das 
Steuerungsverfahren gibt einen vortetlhaften Algorithmus 
an, mit dem die Einheit u nd der Maji jpjjlatorarm gesteuert 
werden k5nnen. Es wird eine Hybridvariante favorisiert, bei 
der der Effektor mit einer Andruckkraft, die durch einen 
Kraftsensor gemessen wird, an eine Wand gedruckt wird 
und dabei die Einheit dem Effektor folgt. Einsatzbereiche 
sind beispielsweise Industriestaubsauger, autonome Robo- 
ts r die Wande anstreichen soilen oder postaustragende 
Fahrzeuge. 
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Beschreibung 

Der Trend in der technischen Entwicklung geht dahin, regelmaBig wiederkehrende Tatigkeiten von Maschi- 
nen ausfiihren zu lassen. Es wird weiter versucht, auch Tatigkeiten die eine gewisse Mobilitat erfordern von 
5 Maschinen verrichten zu lassen. Beispiele ftir solche Tatigkeiten sind das Austragen von Post, Reinigungstatig- 
keiten, oder das Fulien von Flachen mit Farbe. FUr diese Verrichtungen werden haufig autonome mobile 
Einheiten eingesetzt. Diese mtissen sich dabei in unstrukturierten mit Hindernissen versehenen Umgebungen 
bewegen. Dazu benStigen sie geeignete Orientierungsverfahren und Sensoren, mit denen sie in ihrer Umgebung 
in Wechselwirkungen treten kdnnen. Von WD. Rencken wurde mit dem Artikel "Concurrent Localization and 
10 Mapbuilding for mobile Robots using Ultrasonics-Sensors" zu, PROC 1993 IEEE/RSJ. International Conference 
on Intelligence Robots and Systems, Yokohama, Jap. 26.— 30. Juli 1993, Seite 2192 bis 2197 ein Verfahren 
vorgestellt, welches sich mit der Orientierung und Wegfindung in unbekannten Umgebungen befaBt und dafilr 
eine Losung aufzeigt Ein weiteres Problem solcher autonomen mobilen Einheiten besteht darin, daB diese einen 
einfachen platzsparenden Manipulator besitzen mtissen um die entsprechenden Tatigkeiten verrichten zu k6n- 
15 nen. Hierzu ist keinerlei Stand der Technik bekannt. 

Die der Erfindung zugrundeliegende Aufgabe besteht deshalb darin, eine autonome mobile Einheit anzuge- 
ben, die einen Manipulator besitzt, der eine groBe Reichweite innerhalb der Fiache besitzt, auf der sich die 
Einheit bewegt und der die Einheit nicht bei ihrer Bewegung behindert Weiterhin soli fur die Einheit und den 
Manipulator ein geeignetes Steuerungsverfahren angegeben werden. 
20 Fur die Einheit und den Manipulator wird diese Aufgabe gemaB den Merkmalen des Patentanspruches 1 
gelftst. FUr das Steuerungsverfahren wird die Aufgabe gemaB den Merkmalen des Patentanspruches 1 1 geldst 

Weiterbildungen der Erfindung ergeben sich aus den Unteransprtichen. 

Ein groBer Vorteil der erfindungsgemaBen Einheit besteht darin, daB sie durch einen Manipulatorarm nicht an 
der Bewegung in komplexen Umgebungen gehindert wird und dabei der Manipulator sehr kompakt ist im 
25 Vergleich zu seiner Reichweite. Vorteilhaft kommen dabei ira eingezogenen Zustand die einzelnen Segmente 
des Manipulators Qbereinander zu Iiegen und schlieBen mit der Kontur der autonomen mobilen Einheit ab, so 
daB deren Grundflache durch den Manipulator nur unwesentlich vergrOBert wird. 

Vorteilhaft lassen sich die einzelnen Segmente des Manipulators durch Seilzlige, welche liber Umlenkrollen 
gefuhrt sind, betatigea Diese AusfOhrungsform kommt besonders einer Anwendung ira Konsumentenbereich 
30 zugute, da sie technisch nicht sehr aufwendig und in der Praxis vielf altig erprobt ist 

Vorteilhafterweise sind in den einzelnen Drehgelenken des Manipulatorarmes Stellmotoren vorgesehen, 
welche unabhangig voneinander das jeweilige Segment in eine von der Steuerung vorgegebene Drehlage 
bringen konnen. Durch eine gezielte und direkte Beeinflussung der einzelnen Manipulatorsegmente kann 
flexibel und schnell auf sich andernde Umgebungsbedingungen reagiert werden. 
35 Ein weiterer Vorteil der erfindungsgemaBen Einheit besteht darin, daB der Manipulatorarm innen hohl 
ausgebildet ist, und daB die einzelnen Segmente druckdicht miteinander abschlieBen. So kann beispielsweise 
Faroe aufgebracht werden oder es kann durch einen Unterdruck Schmutz von Flachen abgesaugt werden. 

Ein weiterer Vorteil wird bei der erfindungsgemaBen Einheit dadurch erzielt, daB das Ietzte Segment des 
Manipulatorarmes als Effektor ausgebildet ist So kann beispielsweise ein Pinsel oder eine Saugdttse direkt 
40 gesteuert werden und exakt nach Vorgabe der Steuerung in der Umgebung positioniert werden, um beispiels- 
weise einer Wand zu folgen, oder ein vordefiniertes Bewegungsmuster abzuarbeiten. 

Vorteilhaft ist ein solcher Effektor einer autonomen mobilen Einheit mit einem Sensor ausgestattet der auf 
Hindernisse reagiert So laBt sich auf einfache Weise der Effektor entlang einer Wand fiihren. Bildet man diesen 
Sensor vorteilhaft als KraftmeBfiihler aus, so kann zusatzlich ein entsprechendes Moment von der Steuerung 
45 vorgegeben werden mit dem eine AnpreBkraft des Eff ektors an beispielsweise eine Wand erzielt werden kann. 
Vorteilhaft ist dieser Kraftsensor als Rad ausgebildet, das mit einer Achse auf dem Effektor befestigt ist, wobei 
an der Achse DehnmeBstreifen angebracht sind, mit welchen der Kraftvektor bestimmt werden kann. Durch das 
Rad wird zuverlassig vermieden, daB Reibungseinflusse die Steuervorgange verfaischen kdnnen. 
Vorteilhaft wird die erfindungsgemaBe Einheit nach einem Steuerverfahren betrieben, welches die Bewegung 
so der autonomen mobilen Einheit in der Umgebung und des Eff ektors, welcher an einem Gehausepunkt an der 
Einheit angebracht ist, berucksichtigt So kann vorteilhaft in jenen Teilen der Umgebung, die nicht mit Hinder- 
nissen verstellt sind, der Effektor an der Einheit angelegt werden und in anderen Teilen der Umgebung, die es 
erforderlich machen, der Effektor ausgefahren werden und unterhalb von Gegenstanden der Umgebung operie- 
ren. Weiterhin ist im erfindungsgemaBen Verfahren vorteilhaft vorgesehen, daB der Effektor nie in eine singula- 
55 re Position gerat von der aus er nicht mehr operieren kann. D. h. ftir den Fall, daB er zu nah an der Einheit anliegt, 
wird diese in ihrer Bewegung abgestoppt, bzw. ffir den Fall, daB eine vollstandige Streckung des Manipulators 
droht wird die Einheit hinter dem Effektor hergefiihrt um den Manipulator wieder einzuknicken. Vorteilhaft ist 
es vorgesehen, den Effektor mit dem erfindungsgemaBen Verfahren hybrid zu steuern, & h. in eine Koordinaten- 
richtung wird eine Kraft aufgebracht, welche durch den KraftmeBfuhler bestimmt wird und in die andere 
go Richtung wird durch die Steuerung eine konstante Geschwindigkeit vorgegeben und eingehalten. 
Im folgenden wird die Erfindung anhand von Figuren weiter erlautert 

Fig. la und b zeigen ein globales bzw. ein lokales Koordinatensystem des Manipulators bzw. des Eff ektors. 

Fig. 2a und b zeigen Beispiele fur die Regelung des Effektors, einmal fur den Fall das freie Fahrt stattfindet 
und zum anderen Mai fur den Fall, das der Effektor einer Wand folgen soil. 
65 Fig- 3 zeigt ein Ausf tthrungsbeispiel eines Effektors mit einem Kraftsensor. 

Fig. 4a und b zeigen eine erfindungsgemaBe autonome mobile Einheit einmal mit einem ausgefahrenen und 
das andere Mai mit einem eingefahrenen Manipulatorarm. 

Fig. la zeigt ein Koordinatensystem das sinnvollerweise ftir die Modellierung des Manipulatorarmes in der 
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Steuereinheit der mobilen Einheit verwendet wird. Im Punkt A ist der Manipulator an der autonomen mobilen 
Einheit befestigt und drehbar gelagert Zur Vereinfachung der Steuervorgange wird in diesem Punkt ein 
Geschwindigkeitsvektor \Tvorgegeben. Die Lage der einzelnen Segmente SGI bis SG3 laBt sich dann durch die 
einzelnen Winkel <D1, <D2 und 03, welche die jeweiligen Armsegmente miteinander bilden, beschreiben. Das 
Segment SG3 kann beispielsweise auch als Effektor ausgeftihrt sein. Mit diesem Effektor kann die autonome 5 
mobile Einheit beispielsweise Post austragen, Wande beraalen, Staubsaugen, oder ahnliche Verrichtungen 
durchfuhrea Fur die Modellierung des Manipulatorarms wird vorteilhafter Weise davon ausgegangen, daB die 
Dynamik des Armes keine Auswirkungen auf die Dynamik der autonomen mobilen Einheit hat Diese Annahme 
wurde gemacht, da sie sonst ein System mit sechs Ailgemeinen Variabeln ergeben wUrde, welches sechs 
Differentialgleichungen zweiter Ordnung zur Folge hatte, Ein solches Gleichungssystem ist schwierig iSsbar. Im 10 
Formelteil sind in Gleichung 9 die Allgemeinkoordinaten in Gieichung 10 die verallgemeinerten Krafte und in 
Gleichung 11 die kinetischen Energien angegeben. Aus diesen Energien ergibt sich die Gesamtenergie des 
Systems zur Gleichung 12 und die potentielle Energie aus Gleichung 13. Zur weiteren Herleitung der Zusam- 
menh&nge werden die Gleichungen 12 und 13 in die Gleichung 8 eingefiigt, welche dann in Verbindung mit den 
Gleichungen 9 und 10 in die Gleichung 7 eingesetzt wird, urn die Differentialgleichungen zweiter Ordnung zu 15 
erhalten. 

Experimentell wurde verifiziert, daB diese Differentialgleichungen zweiter Ordnung sehr schwer zu ldsen sind, 
da die Rechenkapazitat der heutigen Steuerungsrechner nicht ausreicht, urn dies in einer akzeptablen Zeit zu 
bewerkstelligen. Ein MaB fur diese Zeit ist beispielsweise die erforderliche Reaktionszeit der Einheit, oder die 
minimale Zykluszeit, mit der die Steuerung der Einheit arbeitet. Aus diesen Grtinden wurde die oben gewahlte 20 
Einschrankung bezUglich der Dynamik gemacht 

Das in Fig. la dargestellte Modell des Manipulatorarmes laBt sich einfacher berechnen. Die verallgemeinerten 
Koordinaten sind in Gleichung 14 und die verallgemeinerten Krafte in Gleichung 15 angegeben. Die kinetischen 
Energien ergeben sich aus Gleichung 16 und die kinetische Energie des Systems wird in Gleichung 17 dargestellt 
Die potentielle Energie des Systems wird mit Gleichung 18 beschrieben. Bei diesem Losungsansatz wurde die 25 
Annahme gemacht, daB der Punkt A in dem der Manipulatorarm befestigt ist, eine Position und eine Geschwin- 
digkeit und eine Beschleunigung aufweist Damit wird eine Bewegung bzw. eine Beschleunigung oder Verzoge- 
rung der mobilen Einheit an der der Arm befestigt ist, beschrieben. Zur L6sung der Differentialgleichung werden 
die Gleichungen 17 und 18 in die Gleichung 8 eingesetzt Zusammen mit den Gleichungen 14 und 15 werden sie 
dann in die Gleichung 7 eingesetzt, um die Differentialgleichungen zweiter Ordnungen zu erhalten. Aus dieser 30 
Vorgehensweise ergeben sich drei Differentialgleichungen zweiter Ordnung. Zur Bewegungssteuerung des 
Armes mussen diese drei Differentialgleichungen simultan fur die zweiten Ableitungen der verallgemeinerten 
Koordinaten geldst werden. Die Lftsung dafOr wird mit Hilfe der linearen Algebra gefunden. Gleichung 19 
reprasentiert dabei die Form der Gleichungen, welche man aus der Lagrange'schen Dynamik erhalt Zur Ldsung 
dieser Gleichung muB die Matix M und der Vektor N entwickelt werden. Die Variable |5 ist der Vektor der 35 
zweiten Ableitung der verallgemeinerten Variables Die allgemeine Form ist in Gleichung 20 und die speziellen 
Werte fur dieses System sind in Gleichung 21 angegeben. Die Matrix M ist in Gleichung 22 und der Vektor N in 
Gleichung 23 dargestellt. Aus der Ldsung der Gleichung 19 fur « ergeben sich die Differentialgleichungen, die in 
den Formeln 25 bis 27 dargestellt sind. Jede Gleichung wird durch denselben Faktor D dividiert, welcher die 
Determinante der Matrix M darstellt und in Gleichung 24 angegeben ist Mit diesem speziellen Ldsungsbeispiel 40 
ist es moglich, die Bewegungen des Manipulators und des angebrachten Effektors mit akzeptablen Zeitverhalten 
zu berechnen. 

Fig- lb zeigt den Effektor EF, welcher an einem Segment des Manipulatorarmes SG eingebracht ist Fur 
diesen Effektor wird vorzugsweise ein lokales Koordinatensystem Yf und Xf verwendet Dieses Koordinatensy- 
stem bildet mit den globalen Koordinaten den Winkel Of. Bei der Bewegungssteuerung des Effektors wird 45 
vorteilhafterweise der EinfluB des Fahrzeuges, dessen Wechselwirkung mit dem Arm und die Wechseiwirkung 
des Effektors mit dem Arm berQcksichtigt Der Arm fungiert dabei als Bindeglied zwischen dem Fahrzeug und 
dem Effektor EF. Zur Manipulators teuerung kann beispielsweise die Position des Armes kontrolliert werden. 
Das bedeutet, daB mit dem Effektor des Armes eine bestimmte Zielposition angesteuert werden solL Diese 
Position wird dabei in kartesischen Koordinaten als Winkel des Effektors mit dem globalen Koordinatensystem 50 
beschrieben, wobei daraus die einzelnen Winkel zwischen den unterschiedlichen Segmenten des Armes berech- 
net werden kdnnen. Die Zielposition wird dabei in kartesischen Koordinaten des Effektors EF angegeben. 
Daraus lassen sich die einzelnen Winkelpositionen der unterschiedlichen Segmente berechnen. Aus denen 
wiederum lassen sich die einzelnen Drehmomente ableiten, welche fur Antriebsmotoren gelten mussen, die an 
den einzelnen Gelenken zwischen den jeweiligen Segmenten des Manipulatorarmes angebracht sind Kl und K2 55 
sind dabei Kontrollparameter; die resultierende Gleichung ist in Gleichung 1 des Formelteiles angegeben. Dabei 
bedeutet der Index i die Numraer des Segmentes, wobei das Segment I direkt mit der autonomen mobilen 
Einheit verbunden ist und der hSchste Wert, beispielsweise 3 den Effektor bedeutet Der Winkel O ist dabei in 
lokalen Koordinaten angegeben. Um ein geschmeidigeres Bewegungsverhalten des Manipulators zu erzielen, ist 
es jedoch vorteilhafter nicht die Position sondern die Geschwindigkeit des Effektors zu kontrollieren. 60 

Fig. 2a zeigt ein regelungstechnisches Blockschaltbild far die Kontrolle der Geschwindigkeit des am Manipu- 
lator angebrachten Effektors EF. Die Kontrolle der Geschwindigkeit anstatt der Position des Effektors kann 
verwendet werden, um eine geschmeidigere Bewegungstrajektorie des Effektors zu erhalten. Den Angaben in 
Fig. 2a liegt wiederum das Koordinatensystem aus Fig. lb zugrunde. Beispielsweise sind von einem Benutzer 
oder von der Steuereinheit die Geschwindigkeiten Xf, Yf und <Df vorgebbar. Aus diesen Geschwindigkeiten 65 
werden die Winkelgeschwindigkeiten der einzelnen Motoren, die an den Gelenken der Segmente des Manipula- 
tors angebracht sind, berechnet Die dafur giiltige Herleitung kann wiederum aus dem Formelteil entnommen 
werdea Am Effektor k6nnen drei unterschiedliche Geschwindigkeiten kontrolliert werden. Zum einen die 



3 



DE 44 25 924 Al 



kartesischen Geschwindigkeiten xf und i>f und die Winkelgeschwindigkeit des Effektors <i>f. Zur Steuerung der 
autonomen mobilen Einheit sollten die Geschwindigkeiten die von der Steuereinheit oder vom Benutzer vorge- 
geben wurden, verwendet werden, urn die einzelnen Winkelgeschwindigkeiten der Gelenke zu bestimmen. Die 
Ableitung dieser einzelnen Winkelgeschwindigkeiten ist in den Gleichungen 28 bis 36 angegeben. Die flir das 
5 Ausfiihrungsbeispiel geltenden Herleitungen sind in den Gleichungen 37 und 38 und die resultierende Transfor- 
mation in Gleichung 39 angegeben. Die einzelnen Motordrehmomente wurden dabei so gesteuert, wie sie in der 
Gleichung 2 angegeben sind. Dabei bedeuten die Konstanten Kl bis K3 die einzelnen Steuerparameter. 

Das in Fig. 2a dargestellte regelungstechnische Blockschaltbild verdeutiicht die einzelnen Zusammenhange. 
Die in Fig. 2a gezeigte Version der Geschwindigkeitsregelung kann verwendet werden, wenn sich die autonome 

10 mobile Einheit in einer Umgebung bewegt, die weitestgehend von Hindernissen frei ist Fur diesen Fail gilt, daB 
keine Wechselwirkungen wie Reitkrftfte oder Impulse auf den Manipulator einwirken und so keine dadurch 
hervorgerufenen Schwingungen in der Steuerung des Armes auftreten konnen. 

Fig. 2 zeigt ein beispielhaftes Blockschaltbild fur die Regelung des Manipulators, wenn auf diesen eine Kraft 
von auBen einwirkt Diese Kraft kann beispielsweise mit einera KraftmeBfuhler, welcher an dem Effektor 

15 angebracht ist, gemessen werden. Der Kraftwert wird beispielsweise an die Steuereinheit weitergeleitet und 
diese steuert die Motormomente dahingehend, daB diese Kraft bezUglich einer Umrandung beispielsweise einer 
Raumbegrenzung entiang deren sich der Roboter bewegen soli, konstant gehalten wird. Bei dieser vorteilhaf ten 
Steuerung der erfindungsgemaBen autonomen mobilen Einheit wird das Hybridprinzip verwendet Dabei wird 
versucht in eine Richtung des lokalen Achsenkreuzes des Effektors beispielsweise der Y-Richtung den Effektor 

20 mit einer definierten Kraft gegen eine Wand des Raumes, in welchem sich die Einheit bewegt, zu pressen. 
Parallel zu der Wand, beispielsweise in X-Richtung wird eine bestimmte Geschwindigkeit der Einheit bzw. des 
Effektors eingehalten. Vorteilhaft kann bei der erfindungsgemaBen Ausfuhrungsform auf eine Entkopplungsma- 
trix verzichtet werden. Die anzuwendende Kraft kann dabei beispielsweise von einem Benutzer in Abh&ngigkeit 
der vorliegenden Anwendung vorgegeben werden. Die Drehmomente zur Erzeugung der korrekten Winkelge- 

25 schwindigkeiten in den einzelnen Gelenken werden dabei berechnet, wie dies bei der Methode der Geschwindig- 
keitskontrolle geschah. AnschlieBend werden die jeweiligen Momente fur die Geschwindigkeiten und die Krafte 
addiert und gemeinsam damit die einzelnen Motoren angesteuert 

Bei der Steuerung ist insbesondere zu beachten, daB sowohl die Einheit als auch der Effektor unterschiedliche 
Geschwindigkeiten besitzen konnen. Die beiden unterschiedlichen Bewegungen werden dabei Uberlagert und 

30 mussen bei der Steuerung beriicksichtigt werden. Das erfindungsgemaBe Verfahren vermeidet dabei insbeson- 
dere Singularitaten des Systems. Das Steuerverfahren beruht dabei prinzipiell darauf, daB wenn der Arm einen 
singularen Punkt erreicht, das Fahrzeug versucht dem Arm zu folgen. Insbesondere kann dabei eine Sicherheits- 
zone festgesetzt werden, mit der die Reichweite des Arms begrenzt wird. Beispielsweise kann sie so gewahlt 
werden, daB falls der Arm 85% seiner Lange erreicht das Fahrzeug dem Arm folgt und somit verhindert, daB der 

35 Arm 100% seiner moglichen Strecklange erreicht Dasselbe kann beispielsweise fur das innere Ende der 
Reichweite des Arms gelten. Beispielsweise kann falls der Arm 15% seiner totalen Strecklange erreicht hat, das 
Fahrzeug so gesteuert werden, daB es sich vom Effektor wegbewegt Mit dem erfindungsgemaBen Verfahren 
wird auf diese Weise ein reflexartiges Verhalten der autonomen mobilen Einheit erreicht Der Vorgang des 
Anpressens des Effektors an eine Wand und der Vorfahrtsfahrt der Einheit laBt sich analog mit einem Menschen 

40 vergleichen, der seine Hand an eine Wand halt und dieser, allein durch Beriihrung, der Wand mit der Hand folgt 
Fig. 3 zeigt ein Beispiel eines Effektors der einen KraftmeBfuhler besitzt Die Fig. 3a ist eine Draufsicht und in 
Fig. 3b ist eine Seitenansicht des Effektors gezeigt Der KraftmeBfuhler besteht dabei aus einem Rad R, das an 
einer Achse AC drehbar gelagert ist Weiter sind an der Achse AC DehnmeBstreif en angebracht, mit denen ein 
Kraftvektor der auf das Rad einwirkt, bestimmt werden kann. Um ein Verkanten des Effektors in engen 

45 Raumbereichen zu vermeiden, sind an seinen auBeren Kanten BerUhrungssensoren BS angebracht Mit diesen 
BerUhrungssensoren kann beispielsweise bei auftreten eines Hindernisses in einer Steuereinheit, in Abhangig- 
keit einer Bewegungstrajektorie des Effektors EF ein Ausweichmandver eingeleitet werden. 

Fur das reflexartige Verhalten des Roboterarmes in Verbindung mit dem Effektor sind unterschiedliche 
EinfluBfaktoren maBgeblich. Zum einen die Art des Beriihungssensors zum zweiten die Lage des BerUhrungs- 

50 sensors am Effektor und zum dritten die Form des Effektors selbst Die einfachste Form des Effektors besteht in 
einem Rechteck, an dessen Ecken Beriihrungssensoren angebracht sind. Eine weitere AusfGhrungsform eines 
Effektors besteht darin, daB das Rechteck beibehalten wird, jedoch eine Seite des Rechtecks mit der die Wand 
berdhrt wird, als Halbkreis ausgebildet wird, an welchem mehrere BerUhrungssensoren im gleichen Abstand 
angebracht werden. Bei der Beriihrung des Effektors mit einem Hindernis kann aus der Zahl und der Lage der 

55 BerUhrungssensoren, welche ein Signal abgeben, in einer Steuereinheit darauf geschlossen werden, wie ein 
geeignetes Ausweichmandver, bzw. ein Steuermanover um der Wand zu folgen, durchzufiihren ist Bei der 
Ausfuhrungsform in Fig. 3 ist zu beachten, daB das Rad an welchen die Kraft gemessen wird, leicht fiber die 
Kontur des Effektors hinausragt 
Diese Ausfuhrungsform besitzt einige Vorteile. Zum einen kann die Kraft mit welcher der Effektor an die 

60 Wand drUckt kontrolliert werden. Zum anderen kann der Effektor viel besser gesteuert werden, da der Kraft- 
vektor auch eine Richtungsinformation bezUglich der Krafteinwirkung enthalt Als weiterer Vorteil wird die 
Reibung zwischen der Wand und dem Effektor vermindert Ein weiterer Vorteil besteht darin, daB mit dieser 
Ausfuhrungsform nicht lediglich punktweise einzelne Signale geliefert werden, sondern daB einer Steuerungs- 
einheit des Armes eine kontinuierliche Kraftinformation zur VerfUgung gestellt wird und damit eine geschmeidi- 

65 gere Bewegung des Effektors erreichbar ist, als wenn einzelne Schalter betatigt oder nicht betatigt werden. 

Bei der Steuerung des Armes und der Einheit kann durch die Aufnahme des Kraftvektors sichergestellt 
werden, daB der Effektor absolut senkrecht zur Wand steht Zur Kontrolle des Effektors EF kann ein Kontroll- 
vektor angegeben werden. Dieser Vektor ist in Gleichung 3 des Formeiteiles dargestellt Die ersten drei 
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Elemente reprasentieren dabei die zugewiesenen Geschwindigkeiten des Effektors. Die letzten drei Elemente 
reprasentieren die zugewiesenen Krafte und Momente die am Effektor ausgeObt werden sollen. FQr den Fall, 
daB nur der Kraftsensor in Kontakt mit der Wand kommt, reduziert sich der Kontrollvektor auf die Form, 
welche in Gleichung 4 angegeben ist Dabei gilt zusatzlich Gleichung 5 und Gleichung 6. Der Vektor, der die 
Kraftrichtung angibt ist mit fund der senkrecht darauf stehende Vektor ist mit n bezeichnet Hier wird 5 
beispielsweise, nachdem ein Wandkontakt hergestellt wurde, der Effektor mit einer Kraft von K3 = 5N an die 
Wand gepreBt Gleichzeitig soil er sich mit einer Winkelgeschwindigkeit von <Df (t x ) um den Mittelpunkt des 
Sensors drehen bis der Kraf tvektor, der gemessen wird, senkrecht auf die Y-Achse des Effektors steht (t x =» 0.0). 
Dies wird dadurch erreicht, daB die Winkelgeschwindigkeit proportional zu t x gemacht wird Das bedeutet, daB, 
wenn diese Komponente gleich 0 ist, daB auch die Winkelgeschwindigkeit gieich 0 ist Um <fr f schnell genug 10 
steuern zu kdnnen, muB eine bestimmte Funktion verwendet werden, um es zu berechnen. Diese Funktion ist in 
Gleichung 6 des Formelteiles dargestellt Falls beispielsweise die Kraftkomponente in X-Richtung sich einen 
gewissen Bereich um 0 herum nahert, wird der Effektor durch die Steuereinheit in X-Richtung bewegt wie dies 
Gleichung 5 angibt. Dabei kann beispielsweise so vorgegangen werden, daB er sich standig senkrecht zum 
gemessenen Kraftvektor bewegt In vorteilhafter Weise wird durch dieses reflexartige Verhalten dem Effektor 15 
ein Navigieren auch um konvexe oder konkave Ecken herum ermdglicht 

Um die Differentialgleichungen des Manipulatorarmes herzuleiten, wurde die Lagrange'sche Dynamik ver- 
wendet Die Gleichung dafilr ist in Gleichung 7 des Formelteils angegeben. Das L in der Gleichung reprasentiert 
die Lagrange'sche, welche in Gleichung 8 angegeben ist Dabei ist mit T die Summe aus der kinetischen Energie 
der einzelnen Teile und mit V die Summe der Potentiellen Energie der Teile bezeichnet Mit qj werden die 20 
verallgemeinerten Variablen und mit Qj werden die verallgemeinerten externen Krafte bezeichnet Die einzel- 
nen verschiedenen Segmente des Armes haben dabei eine Masse, eine Tragheit und eine Lange. Diese werden 
hier beispielsweise mit m 1( m 2 , ma, und Ij, 1% I 3 und l tl 12, b, beschrieben. Die Lagerreibungskoeffizienten der 
einzelnen Drehlager werden dabei mit B t bis B 3 bezeichnet Jenes Armsegment, das am Roboter festgemacht ist, 
erhalt die Nummer 1. In beiden Analysen wurden die Iokalen Variablen Ol bis <D3 in die globalen Variablen pi bis 25 
P3 umgesetzt Diese bedeuten dabei die jeweiligen Winkel, welche die einzelnen Armsegmente mit der globalen 
X-Achse bilden. Mit den Variablen Xi bis X 3 und Yi bis Y 3 werden die Koordinaten der Schwerpunkte der 
einzelnen Armsegmente bezeichnet Im einzelnen gelten in diesem AusfUhrungsbeispiel folgende physikalischen 
Parameter: 



mi= 1kg m 2 = 1kg • m 3 = 1kg 



' 1 1= 0 • 4m 12=0 . 4m 13=0 . 3m 



A " 12 2 12 3 12 



1 m m m 



30 



35 



40 



45 



50 



Fig, 4 zeigt ein Beispiel einer Ausfuhrungsform der erfindungsgemaBen autonomen mobilen Einheit In Teil a 
ist diese Einheit mit dem ausgestreckten Manipulatorarm dargestellt Die Einheit ist mit AE bezeichnet Sie 
besitzt Rader R, mit denen sie sich fortbewegen kann, indem diese beispielsweise angetrieben werden. Der 
Manipulatorarm ist hier in drei Segmenten dargestellt es kdnnen jedoch auch mehr oder weniger Segmente fur 55 
seinen Auf bau verwendet werden. Die Berechnung der Kineraatik gestaltet sich dann entsprechend aufwendiger 
oder weniger aufwendig. Das Armsegment SGI ist in einem Drehlager DG1, welches eine Drehachse DAI 
besitzt an der autonomen mobilen Einheit AE befestigt An seinem Ende ist ein Segment SG2 in einem 
Drehlager DG2 mit einer Drehachse DA2 festgemacht Als Segment 3 ist hier ein Effektor EF verwendet 
worden. Dieser Effektor ist mit einer Seite drehbar in einem Drehgelenk DG3 mit einer Drehachse DA3 an dem 60 
Armsegment SG2 befestigt 

Zu beachten ist hierbei, daB die einzelnen Achsen der jeweiligen Drehgelenke achsparallel sind und senkrecht 
auf den Untergrund stehen, auf dem sich die Einheit fortbewegt In einzelnen Anwendungsfallen kann es auch 
sinnvoll sein, die Drehlage des Drehgelenks 1 anders als senkrecht zum Untergrund zu w&hlen. Beispielsweise 
wenn Wande bemalt werden sollen, kann es sinnvoll sein den Arm nach oben auszustrekken, d. h. den Arm es 
seitlich um 90° gedreht an einer Seitenwand der Einheit anzubringen, um damit Wande von oben bis unten 
Oberstreichen zu kdnnen. 

Fig. 4b zeigt eine erfindungsgemaBe autonome mobile Einheit mit einem eingezogenen Manipulatorarm. 
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Dabei ist zu beachten, daB die Segmente SG2, SGI und der Effektor Qbcreinander zu liegen kommen. Durch 
diese vorteilhafte AusfUhrungsforra des Manipulators wird vermieden, daB dieser im eingezogenen Zustand die 
Bewegungsfreiheit der Einheit beeintrachtigt Deutlich ist zu erkennen das der eingezogene Manipulator unwe- 
sentlich liber die Grundflache der autonomen mobilen Einheit AE hinausragt 
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Patentansprtiche 



1. Autonome mobile Einheit mit Manipulator, 

a) bei der eine Steuereinheit zur Steuerung von Bewegungen der Einheit und des Manipulators 
vorgesehen ist, 

b) bei welcher der Manipulator urn eine Drehachse drehbar gelagert an einer Gehausebegrenzung der 
Einheit angebracht ist, 

c) bei welcher der Manipulator, aus mindestens drei sich langlich erstreckenden Segmenten besteht, 
welche an ihren Enden drehbar liber Drehlager miteinander verbunden sind wobei die Drehlager 
jeweils eine Drehachse aufweisen, 

d) bei der die Drehachsen naherungsweise zueinander achsparailel sind und im Wesentlichen senkrecht 
auf den Untergrund stehen, auf welchem sich die Einheit bewegt 

e) bei der Stellmittel vorgesehen sind, mit denen die einzelnen Segmente unabhangig voneinander in 
ihren Drehlagern verdrehbar sind, 

f) bei der die Segmente so angeordnet sind, daB sie fQr den Fall in dem sie durch Verdrehung an der 
Gehausebegrenzung zu liegen kommen, den Anlegezustand, Ubereinander zu liegen kommen, 

g) und bei der die Lange und Breite der Segmente so bemessen ist, daB diese im Anlegezustand nicht, 
oder nur unwesentlich iiber die Grundflache der Einheit hinausragen. 

2. Autonome mobile Einheit nach Anspruch I, bei der als Stellmittel tiber Umlenkrollen gefiihrte SeilzQge 
vorgesehen sind. 

3. Autonome mobile Einheit nach Anspruch 1, bei der als Stellmittel Motoren an den jeweiligen Drehgelen- 
ken vorgesehen sind m . L x.i 

4. Autonome mobile Einheit nach einem der vorangehenden Ansprfiche, bei der die Segmente innen honl 
und druckdicht miteinander verbunden sind 

5. Autonome mobile Einheit nach einem der vorangehenden Anspruche, bei der das letzte Segment als 
Effektor ausgebildet ist . 11M , 

6. Autonome mobile Einheit nach Anspruch 5, bei der der Effektor als SaugdQse, oder Pmsel ausgebildet ist 

7. Autonome mobile Einheit nach einem der vorangehenden Anspriiche, bei der das aufierste Segment 
mindestens einen Sensor zum Feststellen eines Hindernisses aufweist 

8. Autonome mobile Einheit nach Anspruch 7, bei der als Sensor ein Bertihrungsschalter vorgesehen ist. 

9. Autonome mobile Einheit nach Anspruch 7, bei der als Sensor ein KraftmeBfQhler vorgesehen ist 

10. Autonome mobile Einheit nach Anspruch 9, bei der als KraftmeBftthler ein Rad auf einer Achse 
vorgesehen ist, aus deren Verbiegung ttber Dehnmefistreifen der Kraftvektor abgeleitet wird 

11. Steuerverfahren fur eine autonome mobile Einheit mit einem urn eine Drehachse drehbaren Manipula- 
tor aus mehreren, an ihren Enden Qber Drehlager mit einer Drehachse verbundenen Segmenten bei der alle 
Drehachsen des Manipulators naherungsweise achsparailel sind und im Wesentlichen senkrecht auf den 
Untergrund stehen, auf welchem sich die Einheit bewegt und die als SuBerstes Segment einen Effektor mit 
Kjraf tmeBfiihler besitzt, 

a) bei dem falls der Effektor auf seinem Weg zu einem Ziel keiner Raumbegrenzung folgen soli, in 
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einem auf den Effektor bezogenen lokalen Koordinatensystem dessen Geschwindigkeitskomponenten 
in x-,y- und Drehrichtung vorgegeben werden ,und daraus Antriebsmomente fQr an den Drehgelenken 
vorgesehene Motoren zum Verdrehen der Segmente abgeleitet werden, so dafl ffir drei Segmente gilt: 



3 s 



5 -*»<♦•» -<fc-fc» 

mit: 

Index 1, 2, 3, Nummer des Segmentes von der Einheit aus gez&hlt 
Index tar Zielpunktbezogen 
T Antriebsdrehmoment 
k Regelparameter 

P zeitliche Ableitung einer globalen Variable 

O Winkel zwischen den einzelnen Segmenten, fur das erste mit der x-Achse 

b) bei dem falls der Effektor einer Raumbegrenzung folgen soil fiber den Kraf tmefifQhler die Andruck- 
kraft zwischen der Raumbegrenzung und dem Effektor gemessen wird, wobei die Andruckkraft da- 
durch konstant gehalten wird, daB aus der Geometrie des Manipulators der aktuell gemessenen 
Andruckkraft und einer Soll-Andmckkraft ein Korrekturmoment ermittelt wird, welches zu dem unter 
a) gefundenen Moment nach Betrag und Richtung aufsummiert wird um die jeweiligen Antriebsmo- 
mente zu ermitteln, 

c) und bei dem in Abh&ngigkeit einer aktuellen Strecklange des Manipulators die Einheit in Bewegung 
versetzt, bzw. angehalten wird. 

12. Verfahren nach Anspruch 11, bei dem als Streckfaktor das Verhfiltnis aus aktueller Strecklange des 
Manipulators und mdglicher Strecklange des Manipulators gebildet wird, wobei bei Oberschreiten eines 
ersten Grenzwert es fur den Streckfaktor die Einheit in Richtung des Effektors bewegt wird und bei 
Unterschreiten eines zweiten Grenzwertes fur den Streckfaktor die Einheit angehalten wird. 
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